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(57) Abstract: An active -constraint robot (4), 
particularly for surgical use, is controlled by 
means of a series of motorised joints to provide 
a surgeon with real-time tactile feedback of 
an operation in progress. The robot system 
holds, in memory, a series of constraint 
surfaces beyond which it would be dangerous 
for the surgeon to go, and a resistive force is 
applied to the cutting tool (14) as the surgeon 
approaches any such surface. To improve 
the overall quality of feedback experienced 
by the surgeon, the resistive force applied to 
the cutting tool (14) depends upon the point 
of intersection (1) between the force factor 
applied by the surgeon and the surface. Further 
improvements are achieved by adjusting the 
tangential resistive force, when the tool is 
adjacent to the surface, in dependence upon 
the surrounding shape of the surface. 
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constraint surfaces beyond which it would 
be dangerous for the surgeon to go, and a 
resistive force is applied to the cutting tool 
(14) as the surgeon approaches any such 
surface. To improve the overall quality of 
feedback experienced by the surgeon, the 
resistive force applied to the cutting tool 
(14) depends upon the point of intersection 
(1) between the force factor applied by 
the surgeon and the surface. Further 
improvements are achieved by adjusting the 
tangential resistive force, when the tool is 
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Active-Constraint Robots 

The present invention relates to active-constraint robots, and to methods of 
controlling such robots. 

5 

According to one aspect of the present invention there is provided a method of 
controlling an active-constraint robot, comprising the steps of: providing an 
active-constraint robot including a tool for operating on an element and at least 
one drive unit for controlling movement of the tool; providing a model 
10 including a NURBS surface describing at least one surface of the element to be 
operated on by the tool; determining the proximity of the tool to the NURBS 
surface; and controlling the at least one drive unit of the robot by resisting 
movement of the tool in response to the determined proximity to the NURBS 
surface. 

15 

Preferably, the NURBS surface is tessellated in determining the proximity of 
the tool thereto. 

More preferably, the NURBS surface is coarsely tessellated and a first search is 
20 performed to identify a surface point close to a tool point of the tool, thereby 
enabling a first determination of the proximity of the tool to the NURBS 
surface. 

Yet more preferably, an iterative procedure is employed to determine, from the 
25 identified surface point, a surface point having a minimum distance from the 
tool point. 
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In a preferred embodiment the iterative procedure is a Newton-Raphson 
iterative procedure. 

According to another aspect of the present invention there is also provided a 
5 method of controlling an active-constraint robot, comprising the steps of: 
providing an active-constraint robot including a tool for operating on an 
element and at least one drive unit for controlling movement of the tool; 
providing a model including a NURBS surface describing at least one surface of 
the element to be operated on by the tool; determining the imaginary point of 
10 intersection of the axis of the tool and the NURBS surface; and controlling the 
at least one drive unit of the robot by resisting movement of the tool in response 
to the determined point of intersection. 

Preferably, the NURBS surface is tessellated in determining the point of 
15 intersection. 

More preferably, tessellations of a first resolution and at least one higher, 
second resolution are generated, the tessellations of the first resolution enabling 
a first determination of the point of intersection and the tessellations of the 
20 second resolution enabling a second, more accurate determination of the point 
of intersection. 

According to a further aspect of the invention, there is provided a method of 
controlling an active-constraint robot, comprising: 

25 providing an active-constraint robot (4) including a tool (14) for 

operating on element , and a drive unit (20,28,38) for controlling 
movement of the tool; 
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providing a model including a NURBS surface describing a constraint 
surface associated with the element; 

determining the imaginary point (I) of intersection of a force vector (V) 
representative of a force applied by a user to the tool and the NURBS 
5 surface; and 

controlling the drive unit (20,28,38) by resisting movement of the tool 
according to the determined point of intersection. 



According to another aspect there is provided a method of controlling an active- 
10 constraint robot, comprising: 

providing an active-constraint robot (4) including a tool (14) for 
operating on element , and a drive unit (20,28,38) for controlling 
movement of the tool; 

providing a model including a model surface describing a constraint 
15 surface associated with the element; 

determining the imaginary point (I) of intersection of a force vector (V) 
representative of a force applied by a user to the tool and the model 
surface; and 

controlling the drive unit (20,28,38) by resisting movement of the tool 
20 according to the determined point of intersection. 

According to another aspect there is provided an active-constraint robot (4) 
including: 
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a tool (14) for operating on an element; 

a drive unit (20,28,38) for controlling movement of the tool; 

means for holding a model including a NURBS surface describing a 
constraint surface associated with the element; 

5 means for determining the imaginary point (I) of intersection of a force 

vector (V) representative of a force applied by a user to the tool and the 
NURBS surface; and 

a control for controlling the drive unit (20,28,38) by resisting movement 
of the tool according to the determined point of intersection. 

10 

According to another aspect there is provided an active-constraint robot (4) 
including: 

a tool (14) for operating on an element and a drive unit (20,28,38) for 
controlling movement of the tool; 

15 means for holding a model including a model surface describing a 

constraint surface associated with the element; 

means for determining the imaginary point (I) of intersection of a force 
vector (V) representative of a force applied by a user to the tool and the 
model surface; and 

20 a control for controlling the drive unit (20,28,38) by resisting movement 

of the tool according to the determined point of intersection. 
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According to another aspect there is provided a method of controlling an active- 
constraint robot, comprising: 

providing an active constraint robot (4) including a tool (14) for operating 
5 on an element, and a drive unit (20,28,38) for controlling movement of the 

tool; 

providing a model describing a constraint surface associated with the 
element; and 

controlling the drive unit by resisting movement of the tool in a direction 
10 tangential to an adjacent constraint surface in dependence upon the shape of 

the constraint surface in a region surrounding the position of the tool. 

According to another aspect there is provided An active constraint robot (4) 
including: 

a tool (14) for operating on an element; 

1 5 a drive unit (20,28,38) for controlling movement of the tool; 

means for holding a model describing a constraint surface associated 
with the element; and 

control means for controlling the drive unit by resisting movement of the 
tool in a direction tangential to an adjacent constraint surface in 
20 dependence upon the shape of the constraint surface in a region 

surrounding the position of the tool. 
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The invention may be carried into practice in a number of ways and one specific 
robot system, along with various methods of controlling it, will now be 
described, by way of example, with reference to the accompanying drawings, in 
which: 

5 

Figure 1 illustrates generally a surgical robot system in accordance with 
a preferred embodiment of the present invention; 

Figure 2 is an electrical connection diagram for the robot system of 
Figure 1; 

10 Figure 3 explains the active constraint control principle; 

Figures 4 to 15 show various aspects of a preferred robot, for use with 
the robot system of Figure 1; 

Figure 16 A illustrates a method of control using a proximity test; 

Figure 16B illustrates a method of control using a surface-intersection 

15 test; 

Figure 17 shows a robot control scheme with PD control law and friction 
and gravity compensation; 

Figure 18 shows a control principle under which the stiffness changes 
only in the direction towards the boundary; 
20 Figure 19 illustrates what is meant by "2.5-D constraint"; 

Figure 20 shows instability at a sharp edge; 

Figures 21 and 22 illustrate adjustment of the tangential stiffness for a 
2-D boundary; 

Figure 23 shows a 2-D outline of the constraint for preparing the surface 
25 of the tibia; and 

Figure 24 shows two line segments at an angle. 
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Figures 1 to 2 illustrate generally a surgical robot system in accordance with a 
preferred embodiment of the present invention. 

The surgical robot system comprises a trolley 1, a gross positioner 3, in this 
5 embodiment a six-axis gross positioner, mounted to the trolley 1, an active- 
constraint robot 4 coupled to the gross positioner 3, and a control unit. The 
robot 4 is of smaller size than the gross positioner 3 and actively controllable by 
a surgeon within a virtual region of constraint under the control of the control 
unit 

10 

The trolley 1 provides a means of moving the robot system relative to an 
operating table 5. The trolley 1 includes two sets of clamps, one for fixing the 
trolley 1 to the floor and the other for clamping to the operating table 5. In this 
way, the robot system and the operating table 5 are coupled as one rigid 
15 structure. Also, in the event of an emergency, the trolley 1 can be undamped 
and easily removed from the operating table 5 to provide access to the patient 
by surgical staff 

The gross positioner 3 is configured to position the robot 4, which is mounted to 
20 the tip thereof, in an optimal position and orientation in the region where the 
cutting procedure is to be performed. In use, when the robot 4 is in position, the 
gross positioner 3 is locked off and the power disconnected. In this way, a high 
system safety is achieved, as the robot 4 is only powered as a sub-system during 
the cutting procedure. If the robot 4 has to be re-positioned during the surgical 
25 procedure, the gross positioner 3 is unlocked, re-positioned in the new position 
and locked oif again. The structure of the control unit is designed such as to 
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avoid unwanted movement of the gross positioner 3 during the power- 
on/power-off and locking/releasing processes. 

The operating table 5 includes a leg fixture assembly for holding the femur and 
5 the tibia of the leg of a patient in a fixed position relative to the robot 4 during 
the registration and cutting procedures. The leg of the patient is immobilised in 
a flexed position after the knee is exposed. The leg fixture assembly comprises 
a base plate, an ankle boot, an ankle mounting plate, a knee clamp frame and 
two knee clamps, one for the tibia and the other for the femur. The base plate, 

10 which is covered with a sterile sheet, is clamped to the operating table 5 and 
acts as a rigid support onto which the hip of the patient is strapped. The ankle is 
located in the ankle boot and firmly strapped with Velcro ™ fasteners. The 
ankle mounting plate, which is sterilised, is clamped through the sterile sheet 
onto the base plate. The ankle boot is then located in guides on the ankle 

15 mounting plate. In this way, both the hip and the ankle are immobilised, 
preventing movement of the proximal femur and the distal tibia. The knee 
clamp frame is mounted to the operating table 5 and provides a rigid structure 
around the knee. The knee clamps are placed directly onto the exposed parts of 
the distal femur and the proximal tibia. The knee clamps are then fixed onto the 

20 knee clamp frame, thus immobilising the knee. 

The robot 4 is a special-purpose surgical robot, designed specifically for 
surgical use. In contrast to industrial robots, where large workspace, high 
motion speed and power are highly desirable, these features are not needed in a 
25 surgical application. Indeed, such features are considered undesirable in 
introducing safety issues. 
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Figure 3 shows in more detail a preferred implementation of the active 
constraint principle. 

The inner loop is an independent joint position/velocity control loop. The 
5 position controller implements a PD control law in joint space: 

r = Kp(0 d - 0) +K D (0 d - ©) (1) 

t is the torque output from the position controller to the robot motors. Position 
10 control gains Kp (proportional) and Kjy (derivative) can be adjusted by the 
boundary controller to achieve the desired stiffness and damping of the robot. 
0^/ and are joint position and velocity demands respectively and are set by 

the boundary controller. © and © are actual joint position and velocity 
respectively (measured with encoders). 

15 

The boundary controller in the main control loop monitors the Cartesian 
position X of the cutter relative to the boundary of the safe region. It changes 
the gains of the position controller, and sets the position demand according to 
the minimum distance between the cutter and the boundary. The surgeon's 
20 motion commands are provided by measuring the surgeon's guiding force Fq. 

The Cartesian velocity demand for the position controller is set according to the 
surgeon's force: 



25 



X<j = A • Fg (2) 
A is the admittance, which again depends on the minimum distance to the 
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boundary. The Cartesian position demands are transformed to joint space by 
inverse kinematics and inverse Jacobian computation [Sciavicco, L and 
Siciliano, B J 996. Modelling and Control of Robot Manipulators. McGraw- 
Hill]. The robot's workspace is divided into three regions, where the behaviour 
5 of the boundary controller is different. Region I (RI) is a region far from the 
boundary where the motion of the robot is free. The position control gains are 
low which means that the stiffness and damping of the robot is low. The 
admittance is high to achieve high sensitivity to the sturgeon's commands, 
leading to smooth motion with a low guiding force. Position demand is set to 
1 0 the current position. 

Region II (RH) is an area near the boundary. The boundary controller increases 
the position control gains and decreases . the admittance as the minimum 
distance between the cutter and the boundary decreases. This makes the robot 
15 stiffer when the cutter approaches the boundary. Admittance at the boundary is 
set to 0, effectively transforming the whole controller into a position controller 
with high gains. Position demand is again set to the current position. 

Region HI (RIII) is a region beyond the boundary and is outside the safe region 
20 and so must never be reached. However, this is impossible to achieve without 
very large and powerful motors. Instead, the position control gains are set to 
very high values, with the position demand set to the nearest point on the 
boundary in order to push the cutter back into the safe region. In this way a 
stable control without vibrations is achieved at the boundary, since the 
25 constraining force increases gradually over the Region 13. If that was not the 
case (no Region II), it would be easy to push the cutter into Region III (due to 
the delays in the control loop), leading to a very high resisting force. This would 



i 



WO 02/060653 



PCT/GB02/00365 



11 

push the cutter back inside the boundary and, since there is no resisting force in 
Region I, the process could be repeated, resulting in the cutter vibrating at the 
boundary. 

5 The boundary control is very computationally expensive, due to the 
sophisticated algorithms for adjusting the gains and demands for the position 
controller, and kinematics computations. The time delay between two 
subsequent computations can cause stability problems. The independent joint 
position/velocity control incorporates a very simple control law and can 
10 therefore be executed at a higher sample rate, which increases stability of the 
boundary control. 

Figures 4 to 15 illustrate an active-constraint robot 4 in accordance with a 
preferred embodiment of this aspect of . the present invention. 

15 

The robot 4 is of a small, compact and lightweight design and comprises a first 
body member 6, in this embodiment a C-shaped member, which is fixedly 
mounted to the gross positioner 3, a second body member 8, in this embodiment 
a rectangular member, which is rotatably disposed to and within the first body 

20 member 6 about a first axis A l5 a third body member 10, in this embodiment a 
square tubular member, which includes a linear bearing 11 mounted to the 
inner, upper surface thereof and is rotatably disposed to and within the second 
body member 8 about a second axis A 2 substantially orthogonal to the first axis 
Ai, a fourth body member 12, in this embodiment an elongate rigid tubular 

25 section, which includes a rail 13 which is mounted along the upper, outer 
surface thereof and is a sliding fit in the linear bearing 1 1 on the third body 
member 10 such that the fourth body member 12 is slideably disposed to and 
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within the third body member 10 along a third axis A 3 substantially orthogonal 
to the second axis A 2 , and a cutting tool 14 which is removably disposed to the 
forward end of the fourth body member 12. 

5 In this embodiment the axes of the two rotational joints, that is, the pitch and 
yaw, and the translational joint, that is the in/out extension, intersect in the 
centre of the robot 4, thus forming a spherical manipulator. 

In this embodiment the cutting tool 14 includes a rotary cutter 15, for example a 
10 rotary dissecting cutter, at the distal end thereof 

In this embodiment the fourth body member 12 is hollow to allow the motor, 
either electric or air-driven, and the associated cabling or tubing of the cutting 
tool 14 to be located therewithin. 

15 

The robot 4 further comprises a grip member 16, in this embodiment a handle, 
which is coupled to the fourth body member 12 and gripped by a surgeon to 
move the cutting tool 14, and a force sensor unit 18, in this embodiment a force 
transducer, for sensing the direction and magnitude of the force applied to the 
20 grip member 16 by the surgeon. In use, the surgeon operates the robot 4 by 
applying a force to the grip member 16. The applied force is measured through 
the force sensor unit 18, which measured force is used by the control unit to 
operate the motors 22, 30, 40 to assist or resist the movement of the robot 4 by 
the surgeon. 

25 

The robot 4 further comprises a first back-driveable drive mechanism 20, in this 
embodiment comprising a servo-controlled motor 22, a first gear 24 connected 
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to the motor 22 and a second gear 26 connected to the second body member 8 
and coupled to the first gear 24, for controlling the relative movement (yaw) of 
the first and second body members 6, 8. 

5 The robot 4 further comprises a second back-driveable drive mechanism 28, in 
this embodiment comprising a servo-controlled motor 30, a first toothed pulley 
32 connected to the motor 30, a second toothed pulley 34 connected to the third 
body member 10 and a belt 36 coupling the first and second pulleys 32, 34, for 
controlling the relative movement (pitch) of the second and third body members 
10 8, 10. 

The robot 4 further comprises a third back-driveable drive mechanism 38, in 
this embodiment comprising a servo-controlled motor 40, a first toothed pulley 
42 connected to the motor 40, a second toothed pulley 44 rotatably mounted to 
15 the third body member 10, a belt 46 coupling the first and second pulleys 42, 
44, a pinion 48 connected to the second pulley 44 so as to be rotatable therewith 
and a rack 50 mounted along the lower, outer surface of the fourth body 
member 12 and coupled to the pinion 48, for controlling the relative movement 
(in/out extension) of the third and fourth body members 10, 12. 

20 

In this embodiment the rotational axes, that is, the pitch and yaw, of the robot 4 
are in the range of about ± 30°, and the range of extension is about from 20 to 
35 cm. The permitted workspace of the robot 4 is constrained to a relatively 
small volume in order to increase the safety of the system. 
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In a preferred embodiment the power of the motors 22, 30, 40 is relatively 
small, typically with a maximum possible force of approximately 80 N at the tip 
of the robot 4, as a further safety measure. 

5 In this embodiment all three of the joints between the first to fourth body 
members 6, 8, 10, 12 are back-driveable and have similar mechanical 
impedance. With this configuration, the cutting tool 14 at the tip of the robot 4 
can easily be moved with a low force in any direction when the motors 22, 30, 
40 are unpowered. This is a significant feature of the robot 4 as the surgeon, 
10 when guiding the robot 4, is able to feel the contact forces at the cutter 15, 
which would be undetectable when using a very rigid and non-back-driveable 
robot. 

During a surgical procedure, the robot system is covered by sterile drapes to 
15 achieve the necessary sterility of the system. This system advantageously 
requires only the sterilisation of the cutting tool 14 and the registration tool as 
components which are detachably mounted to the fourth body member 12 of the 
robot 4. After the robot system is so draped, the registration tool and the cutting 
tool 14 can be pushed through the drapes and fixed in position. 

20 

We now turn to a consideration of some NURBS-based methods of controlling 
an active constraint robot. NURBS stands for Non-Uniform Rational 
B-Splines. 

25 Where flat surfaces are used, for example, with the current generation of total- 
knee prosthesis components, and simple, typically spherical, geometry exists for 
unicompartmental components, control can be based on simple geometrical 
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primitives. In the case of a NURBS-based approach, however, no basic 
primitives are available, and a control methodology has to be used to restrict the 
movements of the surgeon to comply with the surface or surfaces as defined by 
the NURBS control points. 

5 

In the ACROBOT ™ robot system as described above, a cutter tool is 
positioned at the end of a robot arm. This arm is configured to provide yaw, 
pitch and in/out motions for the cutter tool. Each of these motions is driven by 
a motor, with the motors being geared to be back-driveable, that is, moveable 

10 under manual control when the motors are unpowered. With the motors 
powered, the robot is capable of aiding the surgeon, for example, by power 
assisting the movements, compensating for gravity, or resisting the movements 
of the surgeon, normally at a constraint boundary to prevent too much bone 
from being cut away or damage to the surrounding tissue. Assistance or 

15 resistance is achieved by sensing the applied force direction and applying power 
to the motors in a combination which is such as to produce force either along 
that force vector for assistance, or backwards along that force vector for 
resistance. 

20 One approach to control is to use a simple proximity test, as will now be 
described. 

In a simple system, a flat plane and an outline tunnel, which is defined by a 
series of co-ordinates around its outline, could define the constraint region, with 
25 the proximity to the plane being computed from the plane equation, and the 
proximity to the tunnel being computed by searching the co-ordinate list to find 
the nearest matching outline segment. With this control system, as the surgeon 
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moves the cutter tool closer to a boundary, the robot would be stiffened and the 
resistance increased. 

Figure 16A illustrates the general principle of such a simple proximity test, 
5 being exemplified in 2D for ease of illustration. In position 1', the tool tip is 
well away from the constraint region, so the ease of movement (indicated by the 
lengths of the arrows) is free in all directions. In position 2', the tool is close to 
the boundary, so, whereas movement away from the boundary is easy, any 
movement towards the boundary is made difficult by the application of a 
1 0 constraining force pushing back against any outward motion. 

Rather than measure absolute proximity, it is proposed in this aspect of the 
present invention to provide a more effective method of determination in which, 
for a given force vector, the movements of the surgeon are analysed to 

15 determine whether those movements would break through the constraint 
boundary, and the distance to that section of the boundary is determined, rather 
than merely finding the closest section. This control method advantageously 
allows the surgeon to work freely parallel, but close to, a surface boundary. If a 
simple proximity test were used, working parallel and close to a surface 

20 boundary would be difficult since the close boundary proximity would be 
detected, resulting in resistance from the robot. 

A NURBS proximity determination has the advantage of being computationally 
less intensive than other NURBS computations. In order to determine the 
25 closest point on a NURBS surface S from a particular point P, a Newton- 
Raphson iterative approach is used [Piegl, L., Tiller W., 'The NURBS Book' - 
Second Edition, Springer Verlag, J 997 (ISBN 3-540-61545-8)1 This iteration 
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is set up to minimise the function S-P. The starting point for the search can 
theoretically be anywhere on the surface. However, faster convergence on the 
minimum can be achieved by first tessellating the NURBS surface coarsely into 
a set of quadrilaterals and then scanning the tessellated surface for the closest 
5 tessellation. The search, is then started from the closest tessellation found. 
Once the closest point is found, the distance between thte point and the tool tip 
is computed, and constraint forces are applied to the active-constraint robot to 
ensure that boundaries are not crossed. 

10 An alternative approach to surface-proximity testing is surface-intersection 
testing, and that latter approach will now be described. 

The determination of the intersection with the NURBS surface allows for a 
more accurate determination as to whether a restraining force needs to be 

15 applied near a constraint boundary. This determination allows for a 
differentiation between heading towards or away from a surface, in which cases 
constraint forces are required or not required respectively, whereas a simple 
proximity test does not allow for such a determination and would result in the 
application of a constraining force in all circumstances for safety. Collision 

20 detection with a NURBS surface is, however, a difficult task. It is simpler to 
tessellate the surface into small regions and scan these regions to determine the 
intersection point. However, there comes a point where this becomes time 
consuming, since, for a high resolution, to determine the intersection point 
exactly, a large number of small tessellated triangles will be needed. The 

25 search time for such a list would be considerable. 
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It has been established that it is possible, providing the surface is relatively 
smooth, to reduce the search time by hierarchically tessellating the surface. An 
initial low-resolution tessellated surface with relatively large facets is first 
tested to determine the approximate position of the intersection. When this 
5 position is found, the position indexes a higher resolution tessellated grid 
around this region. This grid is localised and therefore still of relatively small 
in size. Trade-offs between memory and processing power may allow deeper 
tessellated nesting to provide a higher resolution for the intersection point. 

10 Figure 17 illustrates this determination graphically. The tool tip P is 
represented by a ball on the end of a shaft. For a complex surface, a ball-ended 
or acorn-type tool would be used rather than the barrel cutter used for flat plane 
cutting. A force vector V, indicating the direction in which the surgeon is 
applying force, is projected from the tool tip P through the NURBS surface S. 

15 

In a first pass, the closest large tessellation is found. This position is then 
linked to a finer tessellation mesh, and finally to a yet finer tessellation mesh. 
In this particular example, the intersection point I is found after a search 
through, at maximum, 48 facets. In an ordinary search without hierarchy, up to 

20 4096 facets would have had to have been searched to find the intersection point 
I to the same resolution. It will be understood that this example is fairly 
simplistic in order to allow for easy exemplification of the concept. In reality, 
the sizes of the facets, and the number at each level will be governed by the 
complexity of the surface. A very simple smooth surface needs to contain few 

25 facets at any level of detail, whereas a more complex or bumpy surface will 
require more facets to provide an approximation of the bumps at the top level. 
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Once the intersection point I is found, the distance from the tool tip P is 
computed simply, and the force applied by the surgeon measured. The 
constraining force required is then a function of the distance and the force. 

5 We now turn to a more detailed consideration of the control dynamics of active 
constraint. Three major problems of known active constraint controls for the 
ACROBOT are as follows: 

1 . Vibrating motion at an inclined plane boundary; 
10 2. "Springiness" at the boundary; and 

3. The difficulties of moving the tool along the boundary. 

In order to design a more suitable boundary controller it is worth analysing the 
dynamic behaviour of the ACROBOT under active constraint control. The 
15 dynamic model of a general n-DOF (Degrees of Freedom) manipulator can be 
represented in a standard form as 

M(0)0 + h(0, 0) + f (0, 0) + g(0) = r + J T (0)F B (1) 

20 where 0, 0 and © are joint position, velocity and acceleration vectors (n x 1) 
respectively. M is the inertia matrix (n x n) of the robot, which is symmetric 
and positive definite, h is a vector (n x 1) of Coriolis and centrifugal torques - 
the joint torques caused by motion of other joints. / and g are the joint friction 
vector (n x 1) and the gravity vector (nxl) respectively, t is the vector (wxl) 

25 of joint motor torques. is a generalised force vector (6 x 1) of the external 

forces and torques exerted at the tip of the manipulator. J T is the transpose of 
the Jacobian matrix of the robot, which transforms F£ into joint space. 
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Equation (1) represents the dynamic model as a set of n second-order coupled 
and nonlinear differential equations. 

5 1. Closed-loop Dynamics 

The robot control law can be designed as 

t = K P (0 d - 0) + K D (0 d - ©) + ©) + g*(©) (2) 

10 

where Kp and Kq are diagonal proportional and derivative gain matrices 
respectively (nxn). 0^ and are joint position and velocity demand vectors 

respectively (wxl)./ and g* are friction and gravity compensation vectors (n 
x 1). This robot control scheme is shown in Figure 17. 

15 

Substituting (2) into (1) yields 

M(©)0 + K D © + Kp© + 6 = K P ©a + K D ©d + J^©)** (3) 

20 where 



S = h(©,0) + Af(©,0) + Ag(0) 

Af(©,©) = f(©, ©)-**(©>©) 
Ag(©) = g(0)-S*( 0 ) 



25 
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The contributions of Af and Ag equal zero in the case of perfect compensation. 
In the real world, it is difficult to achieve that (especially for friction 
compensation). It is, however, possible to achieve relatively small Af and Ag. It 
can be observed, that the contribution of Coriolis and centrifugal torques h is 
5 small when the robot motion is slow. This is. true in case of the ACROBOT - 
the robot is guided by a human operator, which is relatively slow. In view of 
this and for the sake of clarity of further analysis, the contribution of 8 can be 
discarded. The dynamic behaviour of the robot is therefore governed mostly by 
inertia of the manipulator (M) 9 control gains (Kp and K&) 9 external force (Fg) 

1 0 and the choice of control demands (& d and ©^). 

It can be observed that in the case of high inertia of the system, the contribution 
of F£ (i.e. human guiding force) is relatively small, and the motion of the robot 
depends mainly on the control parameters. In other words, the robot is non- 
1 5 backdriveable. It also has to be noted, that the motor inertia is included in M, 
which can be quite high, especially with small electrical motors with high gear 
ratios. 

Further analysis will be performed for a single joint only, due to difficulties of 
20 analysing the full set of nonlinear differential equations. Equation 3 can be 
written (discarding 8 and contributions of other joints) for a single joint as 

MB + K D 0 + K F Q = K P e d + K D e d + r B (4) 

25 Where x£ represents the portion of the external force affecting the joint (inline 
with the axis of the joint). The Laplace transform of Equation 4 yields 
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5 



Ms 2 e(s) + K D sB(s) + K P B(s) = K P e d {s) + K D e d (s)+T B (s) (5) 



from which the transfer functions for each of the systems inputs can be derived: 
r i«\ - e(s) Kp 

Cp(s) -0^) " Ms* + K D s + K P (6) 

n ( K n 

■ S) ~e d (s) ~ M^ + Kcs+Kp (7) 

- ®W - 1 

!0 0jrW ~7is(*) ~ M^ + J^s + JO (8) 



Where CpO) and Cj/(» are the position and velocity demand transfer functions 
respectively, and represent the effect of the position and velocity demand on the 
output of the system - position ®(s). Cjt(s) is the force transfer function, which 
15 represents the effect of the external force. 



The behaviour of the system can then be represented with 
20 e ( s ) = C P (s)e d (s) + C v (s)Q d (s) + C f (s)t e (s) (9) 

2. Behaviour Inside the Free Region 



Inside the safe region, the goal of the robot control is to allow free motion while 
25 retaining the surgeon's sense of feel for the hardness of the bone. To achieve 
that, the robots velocity can be controlled so it is proportional to the surgeon's 
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guiding force: 



0 J = 0 

5 

where is the portion of the Cartesian velocity demand transformed into joint 

space (J-^AFq), and A is admittance. Substituting Eq. (10) and x£=xq, where 

10 i(3 is the portion of the surgeon's guiding force affecting the joint (J^Fq), into 
Eq. (9) yields 

0( S ) = 50(5) = jg-L^iAFcis) + ]j^00) (12) 

15 It can be seen that this is a first order system which is asymptotically stable 
(since K& > 0 - negative feedback)- The time constant MIKjy decreases (and 

system's response becomes faster) with a lower inertia M and a higher Kf). 

Furthermore, a higher Kd reduces the influence of xq compared to AFq 9 which 

means that the velocity becomes a iunction of Fq only. Higher A also reduces 

20 the influence of xq on velocity. 



(10) 
(11) 



In the case of high inertia, a relatively high Kd is required for a reasonable 
response, which in turn means a lower influence of xq. On the other hand, a 
low inertia allows for lower Kd (for the same response), which leads to a higher 
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influence of iq - i.e. the surgeon is effectively back-driving the robot. 

Next, the ability to feel forces at the tip of the robot will be examined, which are 
not sensed by the force transducer (i.e. the cutting force). As a measure of that, 
5 the velocity changes that result from this force will be analysed. In reality, if a 
tip force is applied, the surgeon's "control algorithm' 5 would compensate for 
lowered velocity by applying a higher guiding force, and, when cutting, this 
change of force is perceived as due to contact with a harder material. 

10 With F<y=0 and tg=t;t, Eq. (12) becomes 



1 1 



0( 5 ) = sQ(s) = 1 — J — TTis) (13) 



The steady state output can be determined with the help of final value theorem 
15 [Phillips, C L and Nagle, H T (1995). Digital Control System Analysis and 
Design. Prentice-Hall\. 

/(t = oo)=lim5/(5) (14) 
20 For a step tip force {tj{s)=x jjs) the steady state velocity is 

9(t = oo) = hms0(s) = ]^ rT ( 15 ) 



25 



A higher Kj) leads to a lower steady state velocity, which means that the 
surgeon's sensitivity to forces at the tip of the robot decreases. In conclusion, 
the dynamic behaviour of the system in the free region depends on M 9 Kjy and 
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A. For a responsive system with the ability to feel forces, the following 
guidelines for the safe region should be followed: 

• The robot should be designed with low inertia M 
5 (and low friction) - i.e. a back-driveable robot; 

• Low derivative gain Kd - i.e. designed with the 

desired force sensitivity in mind; and 

10 • The admittance A should be designed according to 

the desired guiding force range. 

3. Behaviour at the Boundary 

15 When the robot is at the boundary of the safe region, the motors should prevent 
any further motion into "no-go" region. Assume the robot is at the boundary 
and the surgeon is pushing towards the "no-go" region. To achieve this, the 
position and velocity demands can be set as 

20 0^ « 0 (16) 

*.. 

& d = 0 (17) 



25 



Note that &d is set to th e position of the boundary, which is 0. With these 
demands and T£=t<7 (i.e. the portion of guiding force affecting the joint), Eq. 
(9) becomes 
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0(5) = 



1 



T G (S) 



Ms 2 + K D s + K P 



(18) 



For a step guiding force, the steady state position is 



5 



G(t = oo) = lim s0(s) = -— tg 



(19) 



The position - which is a measure of boundary error - is proportional to l/Kp 9 
and the robot behaves as a spring. The boundary error can be reduced by 

10 increasing Kp, which is, however, limited for stability resons. If the inertia of 
the robot is high, Kp can be set to higher values, leading to a lower error. Note 
that integral gain could be used to reduce this error. However, this would not 
help in this case, since the material has already been machined away. A better 
solution is to compensate the guiding force, thus eliminating the cause of the 

15 error instead of reducing the error by setting high control gains. 

4. Improved Active Constraint Control of the ACROBOT 

The actiye control principle was modified to make the cutting process more 
20 useful and intuitive. The stiffness of the robot still changes according to the 
distance to the boundary in the same manner as before, by lowering the 
admittance A. However, the robot becomes stiffer only in the direction 
towards the boundary, while in other directions the stiffness is kept low as in 
the free region (see Figure 18). This simple change of the boundary control 
25 algorithm significantly improves the task of guiding the robot. When near the 
boundary, the surgeon can move the cutter along or away from the boundary 
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with a very low force. In addition, guiding-force compensation was introduced, 
which substantially reduces the over-boundary error. 

The inner loop control law is similar to Eq. (2), but with added guiding force 
5 compensation %c ( see Section 2), which is set by the boundary controller: 

r = K P (0 d - 0) + Kr>(© d - ©) + -r c + f (©, ©) + g*(0) (20) 



10 5. Boundary Controller 

The boundary control law can be described as follows: First, the nearest point 
X np on the boundary is determined. 

15 d=WK- X np || - (X - X np ) ■ N np (21) 

where N np is the normal of the boundary ztX np , which is set to point inside the 
safe region. Inner loop control gains and demands depend on the d and are 
different in the three regions: Region I, II (inside the safe region) and III ("no- 
20 go" region). Note that Region II is necessary for stability reasons, since a rapid 
change of control parameters would result in a vibrating motion along the 
boundary. 

Region I d > Dj 

25 

The control gains are low to allow the surgeon to feel the cutting forces. 
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Admittance is the same in all directions. The inner loop demands are set as 



0 d = e (22) 
0d = J -1 04*g) (23) 
5 t c = 0 (24) 

Region H Dj > d > 0 

The control gains increase as the distance to the boundary decreases. The inner 
10 loop position demand is the same as in Region II. If the guiding force points 
away from the boundary (FQ-N n p>0) the velocity demand and force 

compensation are also the same. Otherwise, the guiding force is split into 
normal (Fqj*/) and tangential (Fqj 1 ) components: 



15 F GN = (F G -N np )N np (25) 

F G t = F G - F G n (26) 

and ®</ is comprised of two parts: 

20 0 d = J-H^Fqn + ^Fgt) (27) 



where Ajq is the admittance in normal direction, which decreases with distance 
to the boundary: 



25 



(28) 
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The control is much more sensitive to the change of position control gains than 
to the amount of force compensation. The reason for this is that the guiding 
force changes at a much slower rate than the position and the velocity of the 
5 robot. This is true even when hitting a hard surface, due to the damping by the 
surgeon's arm. 

Therefore, the amount of force compensation can be increased over a smaller 
region £>2- Guiding force compensation xq = 0 if d > D2, and increases over 
regioni>2> d> 0 : 

10 

re = ~J r ( 2 Dz f gn) (29) 

Region HI: d<0 

15 The control gains are high in this region. The inner loop position demand is set 
to the nearest point: 

e d = K- 1 x np (30) 

20 If the guiding force points away from the boundary, the 0^ and iq ^ set ^ m 
Region I. Otherwise, the force is again split into normal and tangential 
directions, and the demands are set as 



25 



0 d = 

T C = 



-J t F G n 



(31) 
(32) 
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6. Implementation for a Planar Constraint 

The improved control algorithm was first implemented for a planar constraint - 
5 a plane at an angle with the cutter. This simple constraint provides a good basis 
for testing the control and for empirical determination of control parameters. 
Apart from the modification of the control explained earlier in this section, the 
new implementation has some other advantages. 

10 Firstly, the active constraint control program runs independently on a Nextmove 
DSP processor controller board, while the PC is used as a user interface, data 
storage and safety monitor. A special protocol was developed for a safe data 
transfer and communication between the two processors. This distribution of 
functions allows all the processing power of the DSP to be used only for the 

15 control algorithm, which improves the speed of the control loop. Further, the 
program becomes much simpler and easier to test and debug. Along with the 
safety monitor function of the PC, this substantially increases the safety of the 
system. 

20 Another advantage is that the main control loop is executed in global 
(Cartesian) coordinates. All joints are therefore used equally for the boundary 
control, eliminating the stepping problem of earlier implementations. 

Further, the control is implemented as a true two-level control. The position 
25 control loop is a simple interrupt routine, which is executed every 2ms. It 
implements a simple PD control algorithm for each joint with gravity, friction 
and guiding force compensation - Eq. (20). The main control loop is more 
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computationally intensive, since it includes coordinate transformations, force 
sensor handling and boundary control (see Section 5), and therefore runs at a 
lower speed (approximately 10ms). The high speed of the position control loop 
ensures a stable control during the computation period of the main loop. 

5 

Cutting experiments showed good results for planes, inclined at any angle. 
7. 2.5-D Boundary Constraint 

10 The plane boundary was extended into the 3rd dimension by applying a 2-D 
closed curve constraint as an outside constraint, which is used to protect the soft 
tissue next to the bone. As will be seen from Figure 19, the expression "2.5- 
D" is, in this document, used to signify an extruded 2D shape. This is adequate 
for the nature of the prosthesis used, where the required surface can be 

15 produced by cutting flat planes in sequence. Initially, the same control 
algorithm as for a plane boundary was used. This, however, resulted in 
instabilities near the intersecting edge between the outside and plane 
boundaries. The problem was explored in detail to find the cause. 

20 8. Instability at a Sharp Edge 

When moving across the intersecting edge, the normal to the boundary instantly 
changes direction by 90°, since the outside and the plane boundaries intersect at 
90°. This also means that the constraining force instantly changes direction, 
25 which subsequently leads to instabilities in the control. Figure 20 shows the 
principle of the problem on an example, where the cutter was pushed with a 
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constant guiding force along boundary section A towards boundary section B, 
which intersect at 90°. 

The speed of approaching the edge is of a great importance. The faster the 
5 cutter approaches the edge along the. boundary section A (situation 1), the 
further over the boundary section B (situation 2) it will go before the controller 
reacts (due to delays in the control loop). The size of the constraining force 
depends on this over-boundary error. Greater error leads to greater reaction 
force, which can force the cutter to bounce back into the region before the edge, 
10 which is dominated by the boundary section A (situation 3). In that case, the 
normal switches its direction again and the whole process can be repeated, 
resulting in undesirable vibrations at the edge. The problem also evolves near 
sharply curved surfaces, whose normal vector changes direction within a 
relatively small area compared to the length of Region II. In other words, if only 
15 the nearest point is considered when adjusting Xrf (velocity demand), is 
discontinuous when the normal at the nearest point changes. 

Therefore, the goal is to define the desired velocity so that it is continuous in 
the whole workspace. One way to ensure that, is to adjust j to be the same in 

20 all directions (A j is the same as Ajj). This however leads to difficult motion 
along the boundary. A better solution is to limit the tangential velocity of the 
cutter near such features of the boundary. In other words, the robot has to 
become stiffer in the tangential direction, depending on the distance to such a 
feature. Figures 21 and 22 show how the tangential stiffness should be adjusted 

25 for two different shapes of 2-D boundaries. 

Generally, the stiffness (or the amount of the tangential constraining force) 
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depends upon the shape or curvature of the constraint surface within a (pre- 
defined) region that surrounds the tool tip. 

The normal stiffness and constraining force (Fjsf) depend on the distance to the 

5 nearest point (X n p) - same as for a plane constraint. The tangential stiffness, 

which ensures the stability at the edges, is adjusted according to the 
neighboring/adjacent surface. A particular point on the surface affects the 
stiffness according to the distance of the point to the cutter and the angle of the 
normal to the surface in that point. A smaller distance results in greater 

10 stiffness. Similarly, a smaller angle between the direction of adjusting the 
stiffness and the normal, results in a greater stiffness. The tangential stiffness is 
chosen as the greatest value from the calculations of every point on the surface. 
In Figures 21 and 22 the most influential point for tangential stiffness is labelled 
Xfp. Because the surface is less curved in the first example, the tangential 

15 constraining force (Fj) is lower, leading to higher velocity {V). Alternatively, 

the stiffness could be based on the length of the tangential vector between the 
tip of the tool and the point at which it intersects the constraint surface. 

9. 2-D Boundary Outline 

20 

A modified boundary control strategy is proposed here for a 2.5-D boundary, 
which also controls the stiffness in the tangential direction. The concept is to 
split the guiding force into three orthogonal components and to adjust the 
stiffness separately in each of those directions. The stiffness is adjusted not only 
25 according to the minimum distance to the boundary, but according to the whole 
neighboring surface in the sphere with radius of Region II. For a 2.5-D 
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boundary, this is a quite straightforward process, since the task can be divided 
into two independent parts: a 1-D problem (distance to the plane boundary) and 
a 2-D problem (outside boundary). For a plane boundary, the stiffness in the 
direction towards the plane can be adjusted as explained in Section 5. The 
5 stiffness in the other two orthogonal directions can be adjusted according to the 
outside boundary as follows. 

One way of representing a 2-D boundary outline is with B-spline curves. 
However, this representation would require a relatively large amount of 

10 processing if it was implemented for active constraint control. Due to a limited 
computation power of the DSP processor on the controller board, a better 
approach is to approximate the 2-D curve with a series of points on the curve, 
connected with line segments. The higher the number of points the more 
accurate the representation, but the longer the processing time. A compromise 

15 can be reached, where the curve is represented with a sufficient accuracy and 
the number of points is low enough to allow a reasonably short time delay of 
the boundary control algorithm. 

The strategy discussed in Section 5 works well for a planar constraint and can 
20 also be applied without modification for a convex 2-D curve, since the 
tangential stiffness is not limited. However, for the bone surface preparation a 
closed outline is necessary to protect the surrounding tissue. Figure 23 shows 
an outline for preparing the tibia for the prosthesis component, with an 
extension of the bone outline to allow the robot to approach the bone from the 
25 front. The outlines for other surfaces (i.e. on the femur) are similar. ~ The line 
segment /, if considered separately, affects only in the direction of the 

normal of that segment (Nf): 



WO 02/060653 



PCT/GB02/00365 



35 



X dNi = A m {Fo • NONi - A N iJ?w (33) 

where Ajsft depends on the distance to the nearest point on that segment and is 
5 equal to A if Fq points away from that segment (see Section ?). If all line 
segments are considered, the velocity demand can be chosen as the maximum 
X</ that satisfies the condition 

X d • Ni < Ai** ¥g • N|) < 34 > 

10 

for each line segment / e{l, 2,... ? n). 

The procedure is as follows: First, the segment m with minimum 
A NrrT min i A Ni} is found. Ajq m corresponds to the closest point on the curve in 
15 the half-plane defined by the direction of Fq. The guiding force can then be 
separated in two directions - normal and tangential to that segment: 

F G = (F G • N m )N m +..(F G • T m )T m = F„ m N ra + F Tm T m ^ 

20 The velocity demand can then be formed from each of the two components as 

X d = A N rnF Nm N m + A T F Tm T m (30) 



25 



Where A y can be any tangential admittance, since it does not affect condition ? 
for m-th segment. Substituting Eq. (36) into condition (34) yields 
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{A Nm F Nm N m + A Ti F Tm T m ) • Ni < A Ni F G • N, (37 ) 
and a maximum possible ^77 for segment i can be derived: 

5 F Tm (T m ■ Nj) < 38 > 

To satisfy condition (37) for all segments / 2,..., «}, ^7* is chosen as the 
minimum tangential admittance Ax=min{Ax{) . 

10 If the 2-D curve includes concave surface parts (e.g. PCL protection area in 
Figure 23), the above procedure could lead to incorrect tangential admittance. 
To avoid this, only the part of the line is considered that actually forms a 
surface. The other part is replaced by the point of the intersection of the two 
lines. 

15 

As seen in Section 8, an instability occurs if is not continuous in the whole 
workspace. To prove that as defined above is continuous, an edge formed 
of two line segments at an angle 9 will be examined (Figure 24). The problem 
can appear at the centre line of the edge, since the nearest point changes from 
20 one segment to the other. This results in a different direction of N m , which 
might lead to a different X^/ at the centre line, depending on which segment is 
used in the first step of the procedure. 



25 



Assume that the position of the robot is on the centre line of the edge and the 
nearest point is on segment 1. Note, that A]sfi=A]sj2=Atf 9 since the distance to 

both segments is the same. The velocity demand is 
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and the tangential admittance, defined by segment 2 is 

5 At ~ pwCtTnS (40) 

The relationship between the normals and tangents of the two segments can be 
expressed as 

10 N 2 — coscpNi — sin^Tx (41) 



20 



T 2 = sin <£>Ni + cos y?Ti 



(42) 



and 



Ni • N 2 = cos ip (43) 

15 Ti-N 2 = -sin \P ( 44 ) 

which after some manipulation leads to 

A T = X* (45) 



This means that the admittance at the centre line is the same in both directions, 
arid the order of computation is not important. Therefore, Xj is continuous at 
the centre line and in the whole workspace. 



25 



The 2.5-D algorithm was implemented on the ACROBOT's DSP controller 
board, which was able to execute the algorithm at a rate of approximately 



WO 02/060653 



PCT/GB02/00365 



38 

100Hz (10ms cycle time) for a typical TKR surface. The guiding of the robot 
was smooth, intuitive, and stable, without any undesired "shaking" at sharp 
comers of the boundary, even with high guiding forces applied. 

5 It is expected that a similar approach - that is, in which the tangential stiffness 
depends on the shape of the neighboring surface - will apply to true 3D 
implementations. 

Finally, it will be understood that the present invention has been described in its 
preferred embodiments and can be modified in many different ways without 
10 departing from the scope of the invention as defined by the appended claims. 
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CLAIMS: 

1 . A method of controlling an active-constraint robot, comprising: 

providing an active-constraint robot (4) including a tool (14) for 
5 operating on element , and a drive unit (20,28,38) for controlling 

movement of the tool; 

providing a model including a NURBS surface describing a constraint 
surface associated with the element; 

determining the imaginary point (I) of intersection of a force vector (V) 
10 representative of a force applied by a user to the tool and the NURBS 

surface; and 

controlling the drive unit (20,28,38) by resisting movement of the tool 
according to the determined point of intersection. 

15 2. A method as claimed in claim 1 in which the NURBS surface is tessellated 
in determining the point (I) of intersection. 



3. A method as claimed in claim 2 in which tessellations of a first resolution 
and at least one higher, second resolution are generated, the tessellations of the 
20 first resolution enabling a first determination of the point (I) of intersection and 
the tessellations of the second resolution enabling a second, more accurate, 
determination of the point (I) of intersection. 
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4. A method as claimed in any one of the preceding claims in which 
movement is resisted by applying a constraining force which is a function of the 
distance between the imaginary point of intersection and the tool (14), and of 

5 the force being applied by the user. 

5 . A method of controlling an active-constraint robot, comprising: 
providing an active-constraint robot (4) including a tool (14) for 
operating on element , and a drive unit (20,28,38) for controlling 
movement of the tool; 

providing a model including a model surface describing a constraint 
surface associated with the element; 

determining the imaginary point (I) of intersection of a force vector (V) 
representative of a force applied by a user to the tool and the model 
surface; and 

controlling the drive unit (20,28,38) by resisting movement of the tool 
according to the determined point of intersection. 

6. A method as claimed in claim 5 in which the model surface is tessellated in 
20 determining the point (I) of intersection. 

7. A method as claimed in claim 6 in which tessellations of a first resolution 



10 



15 
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and at least one higher, second resolution are generated, the tessellations of the 
first resolution enabling a first determination of the point (I) of intersection and 
the tessellations of the second resolution enabling a second, more accurate, 
determination of the point (I) of intersection. 

5 

8. A method as claimed in any one of claims 5 to 7 in which movement is 
resisted by applying a constraining force which is a function of the distance 
between the imaginary point of intersection and the tool (14), and of the force 
being applied by the user. 

10 

9. An active-constraint robot (4) including: 

a tool (14) for operating on an element; 

a drive unit (20,28,38) for controlling movement of the tool; 

means for holding a model including a NURBS surface describing a 
1 5 constraint surface associated with the element; 

means for determining the imaginary point (I) of intersection of a force 
vector (V) representative of a force applied by a user to the tool and the 
NURBS surface; and 

a control for controlling the drive unit (20,28,3 8) by resisting movement 
20 of the tool according to the determined point of intersection. 
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10. A robot as claimed in claim 9 including means for tessellating the NURBS 
surface in determining the point (I) of intersection. 



11. A robot as claimed in claim 10 in which tessellations of a first resolution 
5 and at least one higher, second resolution are generated, the tessellations of the 
first resolution enabling a first determination of the point (I) of intersection and 
the tessellations of the second resolution enabling a second, more accurate, 
determination of the point (I) of intersection. 

10 12. A robot as claimed in any one of claims 9 to 11 in which the controller 
resists movement by applying a constraining force which is a function of the 
distance between the imaginary point of intersection and the tool (14), and of 
the force being applied by the user. 



15 1 3 . An active-constraint robot (4) including: 

a tool (14) for operating on an element and a drive unit (20,28,38) for 
controlling movement of the tool; 

means for holding a model including a model surface describing a 
constraint surface associated with the element; 

20 means for determining the imaginary point (I) of intersection of a force 

vector (V) representative of a force applied by a user to the tool and the 
model surface; and 
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a control for controlling the drive unit (20,28,38) by resisting movement 
of the tool according to the determined point of intersection. 

14. A robot as claimed in claim 13 including means for tessellating the model 
5 surface in determining the point (I) of intersection. 

15. A robot as claimed in claim 14 in which tessellations of a first resolution 
and at least one higher, second resolution are generated, the tessellations of the 
first resolution enabling a first determination of the point (I) of intersection and 

10 the tessellations of the second resolution enabling a second, more accurate, 
determination of the point (I) of intersection. 

16. A robot as claimed in any one of claims 13 to 15 in which the controller 
resists movement by applying a constraining force which is a function of the 

15 distance between the imaginary point of intersection and the tool (14), and of 
the force being applied by the user. 

17. A method of controlling an active-constraint robot, comprising: 

providing an active constraint robot (4) including a tool (14) for operating 
20 on an element, and a drive unit (20,28,38) for controlling movement of the 

tool; 

providing a model describing a constraint surface associated with the 
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element; and 

controlling the drive unit by resisting movement of the tool in a direction 
tangential to an adjacent constraint surface in dependence upon the shape of 
the constraint surface in a region surrounding the position of the tooL 

5 

18. A method as claimed in claim 17 in which the tangential direction is 
defined as that direction perpendicular to the shortest line normal to the 
constraint surface which intersects the tool. 

10 19. A method as claimed in claim 18 in which the amount of resistance is 
dependent upon the length of the tangential vector between the tool and a point 
at which it intersects the constraint surface. 

20. A method as claimed in claim 17 or claim 18 in which a plurality of points 
15 lying on the surface and within the region are considered, the amount of 
constraint being a function of the distance of each point to the tool and the angle 
between a normal to the surface at each point and a line extending between each 
said point and the tool. 

20 21. A method as claimed in claim 20 in which a separate value is calculated for 
each said point, with the amount of resistance applied to the tool being set at the 
maximum value for all the said points. 
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22. A method as claimed in claim 17 or claim 18 in which a separate resistance 
value is calculated for a plurality of points lying on the surface and within the 
region, the amount of resistance applied to the tool being determined in 

5 dependence upon the largest of the said separate resistance values. 

23. An active constraint robot (4) including: 

a tool (14) for operating on an element; 

a drive unit (20,28,38) for controlling movement of the tool; 

10 means for holding a model describing a constraint surface associated 

with the element; and 

control means for controlling the drive unit by resisting movement of the 
tool in a direction tangential to an adjacent constraint surface in 
dependence upon the shape of the constraint surface in a region 
1 5 surrounding the position of the tool. 

24. A robot as claimed in claim 23 in which the tangential direction is defined 
as that direction perpendicular to the shortest line normal to the constraint 
surface which intersects the tool. 



20 
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25. A robot as claimed in claim 24 in which the amount of resistance is 
dependent upon the length of the tangential vector between the tool and a point 
at which it intersects the constraint surface. 

5 26. A robot as claimed in claim 23 or claim 24 in which the control means 
considers a plurality of points lying on the surface and within the region, the 
amount of constraint being a function of the distance of each point to the tool 
and the angle between a normal to the surface at each point and a line extending 
between each said point and the tool. 

10 

27. A robot as claimed in claim 26 in which a separate value is calculated for 
each said point, with the amount of resistance applied to the tool being set at the 
maximum value for all the said points. 

15 28. A robot as claimed in claim 23 or claim 24 in which the control means 
calculates a separate resistance value for a plurality of points lying on the 
surface and within the region, the amount of resistance applied to the tool being 
determined in dependence upon the largest of the said separate resistance 
values. 
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